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Abstract 

A robot hand should obey movement commands 
from an operator or a computer program as closely 
as possible. However, when two of the three rota- 
tional axes of the robot wrist are colinear, the wrist 
loses a degree of freedom, and the usual resolved-rate 
equations (used to move the hand in response to an 
operator’s inputs) are indeterminant. Furthermore, 
rate limiting occurs in close vicinity to this singular- 
ity. An analysis in this paper shows that rate limiting 
occurs not only in the vicinity of this singularity but 
also substantially away from it, even when the opera- 
tor commands rotational rates of the robot hand that 
are only a small percentage of the operational joint 
rate limits. Therefore, joint angle rates are scaled 
when they exceed operational limits in a real-time 
simulation of a robot arm. Simulation results show 
that a small dead band avoids the wrist singular- 
ity in the resolved-rate equations but can introduce 
a high-frequency oscillation close to the singularity. 
However, when a coordinated wrist movement is used 
in conjunction with the resolved-rate equations, the 
high-frequency oscillation disappears. 

Introduction 

Suppose an operator (human or computer) wants 
the hand of a robot arm to move in a certain direc- 
tion. With resolved-rate control (refs. 1 and 2), the 
operator commands the hand to move with a veloc- 
ity in that direction. Resolved-rate equations trans- 
form the commanded hand velocity into individual 
joint rates in the robot arm to actually move the 
hand. Unfortunately, there are certain positions of 
the robot arm that cause singularities in the equa- 
tions. At these singularities, the equations are inde- 
terminant, and near them, the equations yield joint 
angle rates that exceed operational limits. One solu- 
tion is simply to avoid any positions of the robot arm 
that cause a singularity. However, in an unplanned 
maneuver, an operator issues commands to the robot 
hand, and to move the hand as commanded, the arm 
may inadvertently pass through a singularity. Unde- 
sirable motion may result until the arm moves suffi- 
ciently far from the singularity. Consequently, aux- 
iliary equations are needed to continue controlling 
the robot hand as the arm passes through or near a 
singular position. 

The robot arm configuration shown in figure 1 
is used in this paper. The robot hand axis system 
(A^, Fh) is translated by the waist, shoulder, and 
elbow joint angles (0i, 02 , and #3, respectively) and 
is oriented with the robot wrist joint angles (04, 0$, 
and 0e)* For this configuration, singularities can oc- 
cur in either the translational or rotational equations. 


When the elbow joint angle 03 is 0°, the robot arm 
is fully extended (straightened), and the resolved- 
rate equations for translational motions are singular. 
Translational equations have been developed (ref. 3) 
to move the robot hand at this singular elbow po- 
sition. The present paper addresses another bother- 
some singularity, a rotational one involving the robot 
wrist, that occurs when joint angle rates 04 and 6q 
both produce the same rotation (about Zq) of the 
robot hand. 

Three rotational joints (4, 5, and 6) in the robot 
arm constitute the robot wrist. When joints 4 and 6 
have their rotational axes colinear, the wrist loses 
a degree of freedom, and a singularity appears in 
the resolved-rate equations. Avoiding the singularity 
(ref. 4) restricts the working space of the hand and 
requires additional task planning. Use of the gener- 
alized matrix inverse to solve the equations (ref. 5) 
is generally more computationally complex and can 
yield unwanted hand rotations. For example, in ref- 
erence 6, it is shown that a commanded rotation 
about one axis produces a rotation about a different 
axis. Setting artificial limits or holding previous val- 
ues (ref. 7) can also cause variations from the desired 
hand motions. The robot hand should follow the 
commanded movement as closely as possible, partic- 
ularly in a delicate task situation, such as handling 
radioactive material or assisting in the service and 
repair of a satellite. 

A method was introduced in reference 6 to con- 
trol the robot hand at the wrist singularity. The 
method uses a coordinated movement (equal magni- 
tudes but opposite directions) of 04 and 0q to locate 
the 05 axis in figure 1 for movement of the robot 
hand in the commanded direction. The present pa- 
per is an extension of reference 6. Both analytical 
and simulation results are presented. New analytical 
results are given for joint angle rate limiting in the 
neighborhood of the wrist singularity. In addition, 
the method is implemented in a real-time simulation 
of the robot arm (represented graphically on a moni- 
tor) which moves in response to an operator’s inputs. 
Moreover, joint angle rates are scaled when they ex- 
ceed operational limits, and motion of a probe tip in 
the robot hand is computed for examining deviations 
from desired hand motions in moving near the wrist 
singularity. 

The primary topics addressed in this paper are 

(1) the extent of the occurrence of rate limiting 
in the control of a robot hand by its wrist joints, 

(2) the use of rate scaling to prevent rate limiting 
from occurring, and (3) the performance of a pro- 
posed coordinated wrist movement in comparison 
with the usual resolved-rate equations in handling a 



wrist singularity. Equations apply to the robot arm 
in figure 1 and will be different for other configura- 
tions; however, the results and basic ideas apply to 
robot wrists that have three rotational axes passing 
through a common point. 


Symbols 


E 

elbow of robot arm 

G 

scaling factor 

H 

hand of robot arm; origin of 
hand axis system 

i 

integer to indicate different 
axis systems and associated 
parameters 

; HW 

length from hand to wrist 

Mi 

limit on magnitude of 
rotational rate for joint i 

N 

neck of robot arm 

O 

base of robot arm 

S 

shoulder of robot arm 

t 

time 

Vx,Vy,V z 

linear velocity components 
of robot hand in hand axis 
system 

(V X )c, (V Y )c, (V Z )c 

commanded linear velocity 
components of robot hand 
in hand axis system 

w 

wrist of robot arm 

Xi,Yi,Zi 

axis system for joint i + 1; 
Z{ is the axis of rotation 

^tipi y tip* z tip 

base coordinates of probe 
tip 

$5 

upper limit on absolute 
value of 05 in coordinated 
wrist movement; when 
magnitude of 05 exceeds 
this limit, resolved-rate 
equations are used 

V 

assigned minimum absolute 
value of sin 05 (eq. (6)) to 
avoid wrist singularity in 
resolved-rate equations 

Oi 

joint angle with initial value 
corresponding to position of 
robot arm in figure 1 


Oi 

computed joint angle rate 
for joint i 

w 

resultant rotational velocity 
of robot hand in hand axis 
system 

w c 

commanded rotational 
velocity of robot hand in 
hand axis system 


rotational velocity compo- 
nents of robot hand in hand 
axis system 

{ux)c,{uy)c,{uz)c 

commanded rotational 
velocity components of 
robot hand in hand axis 
system 

^1,2,3 

rotational velocity of robot 
hand caused by rotation of 
joints 1, 2, and 3 in hand 
axis system 

W4,5,6 

rotational velocity of robot 
hand caused by rotation of 
three wrist joints 4, 5, and 6 
in hand axis system 


leveloneAnalysis 

The robot arm with axis systems is shown in fig- 
ure 1. The axis system chosen for operator inputs 
is the robot hand axis system Zq). It is 

assumed that Zj^W = 0 to locate the origin of the 
hand axis system at the intersection of the rotational 
axes of the robot wrist. Thus, wrist rotation (04, #5, 
and 0e) does not translate the origin of the hand 
axis system. The diagram in figure 2 indicates the 
control of the robot arm by kinematic resolved-rate 
equations, which are partitioned as (1) translational 
velocity equations (waist, shoulder, and elbow) that 
translate the robot hand and (2) rotational velocity 
equations (wrist) that orient the robot hand. Singu- 
larities in the translational equations are considered 
in other references (refs. 2, 3, 5, and 7). The com- 
manded linear velocity components (Vx) c , (Vy) c , 
and {Vz)c yield the joint angle rates 0 1, 62 , and 
03. The commanded rotational velocity components 
( CJ x)cj (wy) c , and (wg) c , along with the computed 
joint angle rates 0 1, 02, and 03 > yield the wrist joint 
angle rates 04, 05, and 0g. The robot arm joint angle 
rates are then integrated to get the next set of joint 
angles for movement of the robot arm. Using visual 
feedback (movement of a graphical robot arm on a 
monitor), the operator varies his commands. 
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Resolved-Rate Equations for Robot Wrist 

The resultant rotational velocity of the robot 
hand (in the hand axis system), caused by the six 
rotational joints in the robot arm, is 

<*> = <*>1,2,3 + <*>4,5,6 (1) 

where 07^2,3 is the rotational velocity caused by the 
first three joints (waist, shoulder, elbow) in the robot 
arm, and ^>4,5,6 is the rotational velocity caused by 
the three wrist joints. An operator commands the 
desired rotational velocity ui c in the hand axis sys- 
tem. With w = u? c , equation ( 1 ) gives the necessary 
wrist joint angle velocity as 


w 4,5,6 = W C - <*>1,2,3 ( 2 ) 

Notice that 0^2,3 simply modifies the commanded 
rotational velocity w c . Expressions for u>i ? 2,3 are 
found in reference 6. In the present paper, assume 
<*>1,2,3 — which means the robot hand axis system 
is not translated by the waist, shoulder, or elbow 
joint angles ( 0 \, 62, and #3, respectively).. Then, 
in scalar form, equation (2) relates wrist joint angle 
rates to commanded rotational rates as (ref. 6 ) 

05 = (wx)csin 0 6 + (<*>y )c cos 9 q ( 3 ) 

• _ — (a>x)cCos<? 6 + (a;y) c sin6> 6 

4 sin 05 

06 = (<*>z)c — 04 cos 05 (5) 

When 05 = 0 °, the colinearity of the wrist rotational 
axes Z3 and Z5 in figure 1 causes the wrist to lose 
a degree of freedom. In equation ( 4 ), 04 — * 00 as 
05 — ► 0 °. The problem is to control the robot hand as 
it is commanded at or near this singularity (05 =0°). 

Equations ( 3 ) to ( 5 ) are the resolved-rate equa- 
tions for the wrist joint angle rates to rotate the robot 
hand. The denominator term in equation ( 4 ) is re- 
placed by 

sin 05 = 77 sgn(sin05) (6) 

whenever | sin 05 [ < 77 to avoid an indeterminant 
condition or arithmetic overflow in the vicinity of 
the robot wrist singularity 05 = 0 °. That is, when 
the absolute value of sin 05 is less than 77, sin 05 is 
assigned the value 77 times the algebraic sign of sin 05. 
Different values of 77 are examined in a later section 
of this paper. 

Rate-Limiting Borderlines When Robot Wrist 
Is Controlled by Resolved-Rate Equations 

Physically, joints in the robot wrist can rotate 
only so fast, even if as the wrist singularity is ap- 
proached (05 — > 0°), the computed joint angle rates 


04 and 06 (eqs. ( 4 ) and ( 5 )) are very large. Rate 
limiting occurs when an operator input results in a 
computed joint angle rate that exceeds the opera- 
tional limit of that joint, and the associated joint 
responds by moving at its fastest allowable rate. Ref- 
erence 6 shows that if rate limiting occurs, then un- 
wanted hand movements can result. 


Commanded rotational robot hand rate (c Re- 
consider rate limiting on wrist joint 4 due to (c ox)c* 
With (t oy)c = 0 , nondimensionalize equation ( 4 ) as 

— (k’x)c _ 64 sin #5 

M4 M 4 COS 06 

where M4 is the limiting (maximum magnitude) 
rotational rate of joint 4 . Taking the magnitude of 
equation ( 7 ) gives 


K^xQcl = N sin6> 5 
M4 M4 cos 06 


( 8 ) 


When the operational limit is reached, |04| = M4 and 
equation ( 8 ) becomes 


K^x)c| = Sin 05 
M4 cos 06 


( 9 ) 


The nondimensional magnitude of the operator’s 
commanded input (cj x)c in equation ( 9 ) is a func- 
tion of the magnitudes of the wrist joint angles 05 
and 06 and, by design, is on the borderline of caus- 
ing rate limiting to occur on joint 4 . (Larger values 
will cause rate limiting.) Thus, for given values of 05 
and 06 , equation ( 9 ) gives the maximum magnitude 
of operator input which can be used without causing 
rate limiting on joint 4 . 

The left side of equation ( 9 ) in percent is plotted 
in figure 3 (a) as a function of |05| for specified values 
of 1 06 1 - As an example, if 06 = 0 ° and 05 = 
10 °, rate limiting will occur whenever the magnitude 
of the commanded robot hand rate (c ox)c exceeds 
about 17 percent of the maximum allowable joint rate 
magnitude for joint 4 . 

Similarly, rate-limiting borderlines due to (w^)c 
are established for wrist joint 6 . With (wy) c = 0 and 
(^z)c = 0 , solving equation ( 5 ) for 04, substituting 
into equation ( 7 ), replacing M4 with Mq (the maxi- 
mum rotational rate magnitude for joint 6 ) to nondi- 
mensionalize, and taking the magnitude (| 06 | = Mq) 
yields 


](^x)c| _ tan #5 
Mq COS 06 


( 10 ) 


The left side of equation ( 10 ) in percent is plotted in 
figure 3 (b) as a function of | 0 s| for specified values of 
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|0e|. With 06 = 0° and 05 = 10°, rate limiting will 
occur whenever the magnitude of the commanded 
robot hand rate ( ojx)c exceeds about 17 percent 
of the maximum allowable joint rate magnitude for 
joint 6 with (wy) c = (c oz) c = 0. 


i UJ x)c, (^y)cj and (ujz)c by G and recomputing the 
joint rates. 

With denoting the limit on the rotational rate 
magnitude of joint i, a scaling procedure for the wrist 
joints is indicated in the following steps: 


Commanded rotational robot hand rate (wy )c« An 
equation for rate-limiting borderlines due to (c oy) c is 
obtained for joint 4 from equation (4) with ( u>x)c = 0 
and |04| = M\ as 


l(^y)c] = sin 05 
M4 sin 06 


( 11 ) 


where, once again, M\ is the operational rate- 
limiting magnitude for joint 4. The left side of equa- 
tion (11) in percent is plotted in figure 3(c) as a func- 
tion of 1 05 1 for specified values of |0g|. 

Rate-limiting borderlines due to (cjy) c are gener- 
ated for joint 6 by the equation 


K^yjcJ _ tan 0 5 
Mq sin 00 


( 12 ) 


With (c^x)c = (^z)c = 0, equation 12 is obtained 
by solving equation (5) for 04, substituting this ex- 
pression into equation (4), solving equation (4) for 
(wy) c , nondimensionalizing by Mq (the limit on the 
joint angle rate magnitude for joint 6), and taking the 
magnitude (|00| = Mq). The left side of equation (12) 
in percent is plotted in figure 3(d) as a function of 
1 05 1 for specified values of |0e|. 

The basic message in figure 3 is that rate limiting 
occurs for large wrist joint angles even when the op- 
erator commands rotational rates of the robot hand 
that are only a small percentage of the maximum al- 
lowable joint rate limit. For example, let the joint 
angle rate limit on joint 6 be Mq = 28.6 deg/sec (0.5 
rad/sec). Then, if 00 = 90° and 05 = 12° in fig- 
ure 3(d), the operator command (wy) c must not ex- 
ceed approximately 5.7 deg/sec (0.1 rad/sec) in mag- 
nitude, or rate limiting will occur. These results il- 
lustrate the possible wide range of occurrence of rate 
limiting and the consequent need to incorporate rate 
scaling into the practical control of robot arms. 


Scaling Joint Angle Rates 

The operator’s inputs u c can be scaled so that 
no calculated joint angle rate exceeds its operational 
limit to avoid the rate-limiting problem in resolved- 
rate control near the wrist singularity. However, scal- 
ing the computed wrist joint angle rates 04, 05, and 
06 from equations (3), (4), and (5) by a scale factor G 
gives the same result as scaling the operator inputs 


Step 1: Calculate the wrist joint angle rates 04, 
05, and 06. 

Step 2: If the calculated joint angle rates are 
within their limits (|0^| < M{ for i — 4, 5, and 6), 
use these calculated rates; otherwise, go to step 3. 

Step 3: Multiply the calculated joint angle rates 
in step 1 by the scaling factor 

G = ^ (13) 

l*fcl 

where 0^ is the calculated joint angle rate that most 
exceeds its limit M ) c . 

In step 3, the calculated joint angle rate that most 
exceeds its limit is scaled to equal its limit. This 
means that the other calculated joint angle rates will 
also be scaled by G to fall within their operational 
limits. The joint angle rates 0i, 02, and 03 translate 
the origin of the robot hand axis system and can also 
be included in the scaling process; however, in this 
study, these rates are assumed to be zero. 

Coordinated Wrist Movement To Rotate Robot 
Hand 

When the robot wrist is positioned with 05 = 0° 
(fig. 1), equation (4) is indeterminant. However, use 
of equation (6) allows computations to continue. An- 
other way to rotate the robot hand at the singularity 
is to use the coordinated wrist movement in refer- 
ence 6. In this method, joint angles 04 and 00 are 
varied at maximum rates, but in opposite directions, 
to keep the robot hand stationary. A stationary hand 
is necessary for a smooth nondisruptive movement 
through the singularity. This coordinated movement 
is stopped when Z4 is positioned so that the hand 
can be moved as commanded with 05. Thus, as soon 
as operationally possible, the robot hand will move 
as commanded. As the robot wrist moves away from 
the singularity, the resolved-rate equations are used. 
The coordinated wrist movement is used whenever 

1 05 1 < 65 (14) 

where £5 is a specified constant. In this paper, 
65 = 0.01° (1.75 X 10 -4 rad). In the coordinated 
wrist movement (ref. 6), logic is provided to choose 
the least rotation of joints 4 and 6 that will position 
the robot hand for movement by 05 without violating 
any operational limits. This logic does not exist 
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in the usual resolved-rate equations. Later in this 
paper, an example is given in which a commanded 
hand rotation is possible with the coordinated wrist 
movement, but not with the resolved-rate equations 
when there are joint angle limits. 

Probe Tip 

The origin H of the hand axis system, rather 
than being displaced as shown in figure 1 , is chosen 
to coincide with W (intersection of the robot wrist 
rotational axes Z 3 , Z 4 , and Z 5 ); therefore, wrist 
rotations do not translate the origin of the hand axis 
system. However, the movement of the tip of a probe 
in the robot hand is used to examine deviations from 
ideal movements during robot wrist rotation. The 
length of the probe is assumed to be 188 mm and to 
lie along Zq in figure 1 . Base coordinates of the probe 
tip are denoted by x t j p , f/tipj and ^tip (appendix). 

Results and Discussion 

The robot arm in figure 1 is kinematically sim- 
ulated, and a graphical representation of the arm 
(ref. 8 ) moves in real time on a monitor in response 
to an operator’s commands. The simulation was con- 
ducted on a Control Data CYBER 175 computer 
with an Adams-Bashforth second-order predictor in- 
tegration algorithm having an integration step size 
of 1/32 sec. The primary interest in this paper is 
the rotation of the robot hand by its wrist joints in 
response to the operator’s rotational velocity com- 
mands (u;x)c> (wy)c, and (wz)c- Slower, more accu- 
rate hand movements are preferred over faster, erro- 
neous movements. 

Basic Test Maneuver 

Relative to the robot arm in figure 1, a basic test 
maneuver is defined as a rotation of the robot hand 
about Xq . An operator issues the single rotational 
command (u?x)c for the value of cjx- During the 
maneuver, 0\ = 62 = #3 = 0°. The initial position 
corresponds to the robot wrist singularity (#5 = 0 °) 
in the resolved-rate equations. Equation ( 6 ) is used 
to avoid an indeterminant condition. The operator 
commands (wx)c values sufficiently large to cause 
the wrist joints to rotate at their assumed maximum 
allowable rates (28.6 deg/sec or 0.5 rad/sec). Data 
from this maneuver for two different control schemes 
(resolved rate and resolved rate with coordinated 
wrist movement) are compared for joint angle rates, 
joint angle movements, and probe tip movement. 

Five values of 77 are used in examining the basic 
maneuver. Data for probe x t j p movement are plotted 
to illustrate the effects of 77 . 


Using Resolved-Rate Equations in Test 
Maneuver 

Equations (3) to (5) (the resolved-rate equations) 
and equation ( 6 ) are used to compute the joint an- 
gle rates for the robot wrist in response to the ba- 
sic test-maneuver command ((c^x)c = 0.5 rad/sec). 
These rates are integrated to get the wrist joint an- 
gles, which are used in equation (Al), to compute the 
movement of the probe tip in base coordinates. Fig- 
ure 4 shows the resulting joint angle rates and joint 
angles when a dead-band value of 77 = 10 -5 is used. 
Figure 5 shows the resulting movement of the probe 
tip in comparison with the ideal movement for the 
test maneuver. 

In figure 4(a), joints 4 and 6 counterrotate until 
slightly beyond 3 sec, at which time an undesirable 
oscillation occurs. After the oscillation subsides, 
joint 5 tilts the robot hand. Figure 4(b) shows a 
small- amplitude oscillation in joint angles #4 and 
0q corresponding to the oscillation in figure 4(a). 
Joint angle 64 moves to —90° while 0q moves to 90°; 
afterwards 6 5 tilts the robot hand to 95° (joint angle 
limit) . 

Figure 5 shows a comparison of probe tip move- 
ment for the ideal and the resolved-rate equations. 
(Also shown are results for the resolved-rate equa- 
tions with coordinated wrist movement, which will 
be discussed later.) Ideally, the x-coordinate of the 
probe tip should remain zero throughout the test ma- 
neuver. However, figure 5(a) shows an oscillation 
and slight deviation from the ideal. The y-coordinate 
(fig. 5(b)) and 0 -coordinate (fig. 5(c)) differ from the 
ideal by slightly over 3 sec. Figure 5(d) shows that 
the difference between the ideal and actual y t i p as 
a function of z t - ip is zero; therefore, the probe tip 
travels the same path in the y -0 plane, except for 
the 3-sec delay in transit time along this path. The 
undesirable oscillation in figure 4(a) can be elimi- 
nated by relaxing the dead band 77 , but this results 
in more uncommanded movement of the probe tip. 
To show the effect on the resolved-rate equations of 
various values for the dead band 77 (eq. ( 6 )), the basic 
maneuver was examined for five values of 77 : 10 ~ 5 , 
10 -4 , 10 -3 , 10 -2 , and 10 -1 . The variation of the 
probe tip x-coordinate for each value of 77 was com- 
pared with the ideal. Although relaxing the dead 
band 77 helps eliminate the undesirable oscillations 
seen in figure 4(a), care must be taken that unde- 
sired and uncommanded movement of the probe tip 
is not introduced. Figure 6 illustrates the increase 
in undesired movement as the value for 77 is relaxed 
(i.e., as 77 is increased). 
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Using Resolved-Rate Equations and Coordi- 
nated Wrist Movement in Test Maneuver 

The coordinated wrist movement is used in the 
vicinity (|05| < 65, where 65 = 0.01°) of the wrist 
singularity = 0°. Outside this region, the regu- 
lar resolved-rate equations (eqs. (3) to (5)) with the 
dead band (eq. (6)) are used. Figure 7 shows the 
joint angle rates and joint angles for wrist movement 
in the test maneuver. The undesirable oscillations 
that appeared in figure 4 are not present in figure 7. 
Figure 5 shows the corresponding probe tip coordi- 
nates in comparison with those for the ideal and the 
resolved-rate equations. 

The probe tip movement is identical to the ideal 
test maneuver, except for a time delay of slightly over 
3 sec caused by the rotation of joints 4 and 6. 

Additional Movement Capability From Wrist 
Singularity (#5 = 0°) 

Let the joint angle 64 be limited by |04| < 135°. 
Now, consider the execution of the basic maneuver 
(positive rotation about Xq when the starting wrist 
joint angles are 64 = —130° and 0 $ = 6q = 0°. 
Figure 8 shows the results for resolved-rate equa- 
tions, and figure 9 shows the results for resolved-rate 
equations with coordinated wrist movement. The 
resolved-rate equations yield a negative value for 64 
because the logic is not present that 64 cannot be ro- 
tated negatively through the joint angle limit —135°; 
therefore, O4 varies from —130° to —135° and stops. 
However, the equations for the joint angle rates with 
the coordinated wrist movement do contain this logic; 
hence, 64 varies positively and 0q negatively to ac- 
complish the commanded hand movement. However, 
if the starting wrist position is the same as before, ex- 
cept joint 5 is outside the dead band (eq. (14)) where 
the coordinated wrist movement is used, then the 
basic maneuver cannot be accomplished. The dead 
band could be increased to allow the maneuver, but 
when Zq and Z$ (fig. 1) are not colinear, the robot 
hand will move during the coordinated wrist move- 
ment. A better solution would be to design joints 4 
and 6 for extended rotational capability, so that the 
resolved-rate equations can be used outside a small 
dead band of the wrist singularity without encoun- 
tering a joint limit that prevents further movement 
of the robot hand in a desired direction. Thus, incor- 
porating the coordinated wrist movement offers some 
extended movement capability when joint angle lim- 
its exist. 

Conclusions 

The practical application of resolved-rate control 
theory to teleoperator robot arms has encountered 
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several difficulties. In this paper, rate limiting was 
shown to occur with greater frequency than antici- 
pated. As a result, rate scaling was suggested and 
analyzed as an integral element of controlling a tele- 
operator robot arm. That is, operator control inputs 
were scaled within maximum rate limits to allow a 
more acceptable system response to the frequent oc- 
currence of rate limiting. However, this technique 
still does not solve the movement difficulty associated 
with a wrist singularity in the resolved-rate equa- 
tions. Previous methods of robotic control at a wrist 
singularity have had limitations or adverse side ef- 
fects; therefore, a new method (coordinated wrist 
movement) was investigated and found to have ad- 
vantages compared with previous methods. A robot 
arm was kinematically simulated, and a graphical 
representation of the arm moved in real time on a 
monitor in response to an operator’s commands. 

With respect to robot hand control by its wrist 
joints, the following specific conclusions are drawn: 

1. The percentage of the maximum joint angle 
rate that an operator can obtain is related to how 
close the robot wrist is to the singularity. For ex- 
ample, analytical results show that even as much as 
10° away from the wrist singularity, this percentage 
can be as low as approximately 17 percent. There- 
fore, joint angle rates must be scaled in resolved-rate 
control to avoid rate limiting. 

2. A dead band avoids the wrist singularity in the 
resolved-rate equations, but simulation results show 
that a small dead band leads to a high-frequency 
oscillation when close to the singularity, whereas a 
larger dead band leads to erroneous hand movements. 

3. A coordinated wrist movement of joints 4 and 6 
of the robot wrist to locate joint 5 for movement of 
the robot hand in the commanded direction appears 
to enhance the dexterity of the robot arm at the 
wrist singularity. (Rotational axes of joints 4 and 6 
are colinear.) Simulation results show that there is 
no high-frequency oscillation, and except for a brief 
delay for the coordinated wrist movement, the robot 
hand moves as commanded. 

4. When limits exist on the wrist joint angles, 
the coordinated wrist movement can allow the robot 
hand to perform a maneuver from the wrist singu- 
larity that cannot be performed by the resolved-rate 
equations. It appears that joints 4 and 6 should be 
designed for extended rotational capability to pre- 
vent encountering joint limits that prevent further 
movement of the robot hand in a desired direction. 


NASA Langley Research Center 
Hampton, VA 23665 
February 22, 1985 



Appendix 

Movement of Probe Tip in Robot Hand 
With Respect to Base Coordinate System 

Additional symbols used in this appendix are 
defined as follows: 

C{ — cos 6 1 

C23 = COS (02 + 03) 

L transformation matrix (rotational part) 
from hand coordinate system to base 
coordinate system 

Zes length from elbow to shoulder 

/no length from neck to base 

/gN length from shoulder to neck 

!we length from wrist to elbow 

P06 vector in base coordinates from origin of 
base coordinate system to origin of hand 
axis system 

qo vector in base coordinates from origin of 
base coordinate system to tip of probe in 
robot hand 

qe vector in hand coordinates from origin of 
hand coordinate system to tip of probe in 
robot hand 

S{ = sin 6{ 

S23 = sin(02 + 03) 

Let q 0 be a vector to the tip of a probe in the 
robot hand axis system. Let qo be the vector location 


of this same point with respect to the base coordinate 
system. Then, 

qo = Lq 6 + P06 (Al) 

where L is a rotational transformation matrix (ref. 3) 
and po 6 is the position vector in base coordinates 
from the base coordinate system to the robot hand 
coordinate system. 

With the robot arm parameters in reference 5, the 
equation for po 6 in reference 9 becomes 

( Clt-S^WE + -S^Es) - S l l SN 1 

P06 = \ •S'i(S'23/wE + S^es) + Cl^SN / (A2) 

{ C-^WE + CVES + ^NO J 

In this paper, the coordinates of the tip of the hand 
probe in base coordinates are denoted as x t j p , 2 / t ; p , 
and z t i p ; that is 

( x ti P ) 

qo = ■( 2/tip / (A3) 

1 2 tip J 

The probe is assumed to be 188 mm long and to lie 
along Zq in figure 1. Hence, 


0 \ (A4) 

188 J 

Other distances assumed in this paper are = 
660 mm, /gg = ^WE = 432 mm, and = 152 mm. 
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(b) Rate limiting on wrist joint 6; (wy) c = (^z)c = 0. 

Figure 3. Commanded robot hand rotations on borderlines of causing rate limiting. 





(a) Joint angle rates. 

Figure 4. Joint angle rates and joint angles during test maneuver using resolved-rate equations, r/ = 10 -5 . 
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(b) Joint angles. 
Figure 4. Concluded. 
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(a) z-coordinate of probe tip. 

Figure 5. Comparison of probe tip coordinates during test maneuver, r/ = 10 -5 . 


15 




1800 



(c) ^-coordinate of probe tip. 
Figure 5. Continued. 







Figure 6. Variation of probe tip x-co ordinate with different dead-band values in resolved-rate equations during 
test maneuver. 
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(a) Joint angle rates. 

Figure 9. Joint angle rates and joint angles during test maneuver using resolved-rate equations with coordinated 
wrist movement. \ 0 ^\ < 135°; initially, 64 = —130°; 77 = 10 -5 . 
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